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(54) Vehicle control method and vehicle warning method 



(57) In order to occur a collision warning to prevent 
the collision in accurate by detecting the preceding vehi- 
cle (3) or target, a vehicle lane position estimation 
device comprising a means for measuring a distance 
between said host vehicle (2) and said preceding vehi- 
cle (3) or a oncoming vehicle, a direction angle from 
said host vehicle (2), an angular velocity and a velocity 
of said host vehicle (2), a means for calculating lateral 
and longitudinal distance between said host vehicle (2) 



and said preceding vehicle (3) or said oncoming vehicle, 
a means for capturing a front stationary object, a means 
for obtaining movement of the preceding vehicle (3) or 
position of the oncoming vehicle, and a means to esti- 
mate a lane position of said front stationary object from 
a relationship of the stationary object being captured 
and the preceding vehicle (3) being obtained and a 
positional relationship with the oncoming vehicle. 
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Description 

BACKGROUND OF THE INVENTION 

5 [The technical field that the invention belongs to] 

[0001 ] The present invention relates to an estimation device using a radar to detect dangerous objects for a vehicle. 
[0002] Especially the present invention relates to the estimation device for distinguishing various kinds of non-dan- 
gerous objects which are generally met in typical vehicle driving environment and the dangerous objects which are 
10 authenticity. 

[Prior art] 

[0003] A lot of trials to discriminate the dangerous objects that can be trusted, were performed in a field of a vehicle 
is radar system to measure a distance to the dangerous objects and a relative velocity thereof. 

[0004] In a Japanese Patent Laid-open No. 6 - 282798 bulletin, a target search device is mentioned, the target 
search device comprising a target capture means to capture the target by searching periphery of a service body and to 
get a relative position of the target to the service body, a circular orbit estimation means to estimate a circular orbit of 
the service body in a turning motion of the service body, based on the relative position of the target which the target 
20 capture means got and the circular orbit of the service body (4) which the circular orbit estimation means estimated, 
and a control means to judge whether the target is located in the circular orbit and to distinguish the target located on 
a course of the service body. 

[0005] In a Japanese Patent Laid-open No. 8-83400 bulletin, a method to distinguish dangerous objects for the 
vehicle from the objects which is not the dangerous objects in the vehicle radar system which can detect at least one 

25 object on the road near the vehicle driving in the first vehicle lane is mentioned, said method comprising the steps of a 
step to generate a radar beam having enough beam width to irradiate the object in the first vehicle lane and a second 
vehicle lane which is next thereto, and at least a part of the radar beam generated along a first axis which is generated 
in a right angle substantially, a step to receive a message of a reflex signal from the object irradiated, a step to estimate 
a velocity of the object irradiated about a vehicle velocity in a direction of the second axis (x) which is substantially par- 

30 allel to the service direction of the vehicle based on reflection signal, a step to measure the velocity of the vehicle using 
at least one velocity sensor, a step to judge the irradiated object to be dangerous when a sum of measured the vehicle 
velocity and estimated the velocity which is parallel to the object is bigger than a predetermined threshold, and a step 
to judge the irradiated object not to be dangerous when a sum of measured the vehicle velocity and estimated the veloc- 
ity which is parallel to the object is smaller than the predetermined threshold. 

35 

SUMMARY OF THE INVENTION 

[The subject that invention is going to solve] 

40 [0006] A sensing requirement for a system should be thinking about as that a distance with a preceding vehi- 
cle(including stopping vehicle and an object, herein after called as a target) is controlled to be a desired value (ACC: 
Adaptive Cruise Control) by detecting the lead car in forward of host vehicle lane, or a collide warn is occurred when 
coming too much close to the preceding vehicle or the target. 
[0007] For example, following three phases may be considered. 

45 [0008] The first step: A detectivity ability, that is, may the forward target (the vehicles and road side object) be rec- 
ognized ? 

i) A distance to the target (max especially), relative velocity and detectivity power of angle. 

ii) An accuracy of the vehicle lane judgment of the host vehicle lane / others vehicle lane. 

so 

[0009] The second step: Discrimination ability, that is, may the forward target be recognized ? 
[0010] Especially, is the forward stationary object in forward of the host vehicle discriminated ? ( For example, the 
road side object such as a stationary vehicle, a corner pole and road signs, and an object on the road such as an over- 
head bridge can be distinguished ?) 
55 [0011] The third step: Intention decision, that is, which direction is the driver going to go to ? 

[0012] Is the forward obstacle included in a driving path in the future based on the driver intention ? (there is no 
need to occur the warning when not included.) 

[0013] Referring to the above, an object of the present invention is to provide a vehicle lane position estimation 
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device of the preceding vehicle or the target by improving the vehicle lane decision accuracy of the host vehicle lane / 
other vehicle lane and by detecting the preceding vehicle in forward of the host vehicle lane or the target, so that the 
distance with the preceding vehicle is controlled to be a desired value or a collision warning to prevent the collision with 
the target is generated in accurate. 
5 [001 4] Further, another object of the present invention is to provide a vehicle lane position estimation device of the 
forward stationary object which may recognize in accurate whether the stationary object is a dangerous objects on the 
host vehicle lane or not or whether it is on the host vehicle lane or not 

[001 5] Further, another object of the present invention is to distinguish the stopping preceding vehicle and the sta- 
. tionary object such as a road sign on the road side or an overhead bridge, and to warn or control (decelerate) the stop- 
to ping vehicles which is in forward of the host vehicle. 

[A means to solve the subject] 

[001 6J According to the present invention, algorithm for estimating the host vehicle lane to be accurate in a curved 
75 road and for estimating an accurate correction when a position correction is necessary, is provided on the basis of a 
movement of the preceding vehicle which the radar caught and other sensor information, various data from the vehicles 
side are received, vehicle lane position estimation of the preceding vehicle is performed with a sensing information got 
by a millimeter wave radar, and a one body type millimeter wave radar system is built in a communications network func- 
tion that can transmit an warning or a control command information to the vehicle side and decision / control function, 
20 is provided. 

[0017] In such the vehicle lane position estimation device as above, the present invention further comprising a 
means forjudging whether a curve of said road is a transition curve section where a curvature radius thereof changes 
every moment sometimes, or a maximum curve section where said curvature radius does not changes, and a means 
for correcting a curvature radius R f of said host vehicle used for correcting said curvature radius R f of said preceding 
25 vehicle to be smaller than a predetermined value when a transition curve is in an introduction part of the curve, and for 
correcting said curvature radius R s to be larger than said predetermined value when said transition curve is in an rear 
part of the curve. 

[001 8] In such the vehicle lane position estimation device as above, a vehicle lane boundary position is obtained by ; 
estimating a vehicle lane position of plural preceding vehicle, the host vehicle is judged to be right or left of the vehicle 
30 lane boundary, and a vehicle lane judgment position of said host vehicle is offset towards right or left. 

[0019] In such the vehicle lane position estimation device as above, the present invention further comprising a mil- 
limeter wave radar and a gyro sensor are used as said means for measuring. 

[0020] In such the vehicle lane position estimation device as above, the present invention further comprising a 
means obtaining a distance of the vehicles from said preceding vehicle, and a means for warning when said distance 

35 becomes a predetermined distance. 

[0021] The present invention relates to a vehicle lane position estimation device for estimating a position of a vehi- 
cle lane of a stationary object (a forward stationary object) to be located before an host vehicle, comprising a means for 
measuring a distance between said host vehicle and said preceding vehicle or an oncoming vehicle, a direction angle 
from said host vehicle, an angular velocity and a velocity of said host vehicle, a one vehicle lane sensing means for 

40 obtaining a vehicle lane of a road, a means for calculating a lateral displacement between said host vehicle and said 
preceding vehicle or said oncoming vehicle, a longitudinal displacement therebetween and a curvature radius of said 
host vehicle, a means for capturing a forward stationary object, a means for obtaining a movement of said preceding 
vehicle or a position of said oncoming vehicle, a means for estimating a vehicle lane position of said forward stationary 
object from a movement relationship of said preceding vehicle obtained and said forward stationary object captured or 

45 a position relationship with said oncoming vehicle, and a means for warning when said forward stationary object is in a 
vehicle lane of said host vehicle. 

[0022] In such the vehicle lane position estimation device as above, the present invention further comprising a 
means for recognizing whether said forward stationary object is an object on the road such as an overhead bridge. . 

so BRIEF DESCRIPTION OF THE DRAWINGS 

[0023] 

Figure 1 is a contour block diagram of a distance between vehicles alarm system. 
55 Figure 2 is a contour block diagram of an ACC system. 
Figure 3 is a control block diagram. 
Figure 4 is a figure of account system. 
Figure 5 is a curvature radius illustration. 
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Figure 6 shows related figures of the curvature change and the correction. 
Rgure 7 is a figure of a flow chart of a correction step. 

Figure 8 is a contour block diagram of a distance between vehicles alarm system. 
Rgure 9 is a contour block diagram of the ACC system. 
5 Rgure 1 0 is illustration to discriminate an overhead bridge and a stopping vehicle. 

Rgure 1 1 is a contour block diagram of a distance between vehicles alarm system. 
Rgure 12 is a contour block diagram of an ACC system. 

Rgures 13A and 13B show figures to discriminate a curve and a vehicle lane change of a preceding vehicle. 
Rgure 1 4 is a flow chart of the discrimination method. 
w Rgure 15 is a flow chart of host vehicle lane position estimation. 

Rgures 1 6A and 1 6B show figures of the preceding vehicle and the stationary object recognition and moving veloc- 
ity. 

Rgure 1 7 is a figure of transverse direction transfer of the curve and the vehicle lane change. 
Rgure 1 8 is a figure of the oncoming vehicle and the stationary object recognition. 

15 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENT 

[0024] An embodiment of the present invention will be explained based on a drawings. 

[0025] Figure 1 shows a distance between the vehicles alarm system 1 using a millimeter wave radar, a gyro sen- 
20 sor, or a steering sensor. 

[0026] The figure shows a system configuration in a case that a millimeter wave radar signal is generated from a 
radio antenna unit 4 toward a vehicle 3 from a host vehicle 2, and warn when approaching. 

[0027] The distance between the vehicles • the relative velocity • the angle with preceding vehicle 3 is measured 
with a unit 5 by a conventional method using a radio antenna unit 4 of the millimeter wave radar. 
25 [0028] Measurement is performed with a unit 8 by measuring the angular velocity by a gyro sensor 6, and the steer- 
ing angle is measured by steering sensor 7 with a unit 9. The angular velocity is obtained by integration of the angular 
acceleration signal measured by the gyro sensor. 

[0029] By the measured angular velocity and the steering angle, a vehicle lane is judged with a unit 1 0 according 
to an algorithm mentioned later. 
30 [0030] The preceding vehicle judgment with a unit 1 1 and stationary object judgment with a unit 12 in forward of the 
host vehicle are performed by the distance between the vehicles • the relative velocity • angle (preceding vehicle 3) 
which are measured and vehicle lane judgment. 

[0031] Based on these judgments, an warning judgment with a unit 14 is done by using the warning judgment algo- 
rithm with a unit 13, and a vehicle velocity and a braking signal with a unit 26. 
35 [0032] Based on the warning judgment, an warning designation with a unit 1 5 is performed, and an alarm signal 1 6 
is given, and an alarm sound generation, lighting and display are performed in a driver display unit 17. 
[0033] Figure 2 shows an other embodiment of the present invention, using a millimeter wave radar, a gyro sensor, 
or a steering sensor. 

[0034] ACC system 21 is shown to drive following a preceding vehicle keeping a predetermined distance between 
40 th vehicles. 

[0035] A millimeter wave radar signal is given from a radio antenna unit 4 toward a driving vehicle 3 from the host 
v hide 2, a preceding vehicle detection with a unit 22 and a stationary object sensing 23 are performed by measuring 
the distance between the vehicles • the relative velocity • the angle and the vehicle lane judgment. 
[0036] Based on these sensing, an accelerating and a decelerating judgment with a unit 25 is done by using the 
45 distanc control algorithm 24 between the vehicles, a vehicle speed signal, and a braking signal 26. 

[0037] Based on the judgment result, a vehicle speed holding and the accelerating/decelerating speed signal are 
given with a unit 27, the distance control between the vehicles with a unit 28 comprising a slottle control 29, a A/T shift 
control 30, and a braking control 31 is done. 

[0038] In addition to above, the system of figure 1 , figure 2 namely alarm system and an ACC system do not always 
so exist only as separated system, but a system configuration having both function can be taken. 

[0039] In next, figure 3 shows a hardware configuration to realize an embodiment of the system by figure 1 and fig- 
ure 2 wfth a block diagram. 

[0040] The construction shown in the figure are a one body type millimeter wave radar system 35, a vehicles side 
control part 36, and a display unit 37 for a driver. 
55 [0041] The one body type millimeter wave radar system 35 has, for example, a communication network facility that 
. used CAN, for example, and is constituted with a vehicles side control part 36, a driver display unit 37 and a communi- 
cations network. 

[0042] In the figure, a radar sensing signal obtained by a transmitting antenna 41 built in a unit 35, a receiving 
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antenna 42 and a high frequency circuit 43, and an analog signal from the gyro sensor 6 are converted by an AD con- 
version 44, and are done signal processing by a digital signal process circuitry 45 ( constituted with CPU, DSP etc. ). 
[0043] Said digital signal process circuitry 45 is installed a software as built-in software 47, in order to process a 
risk judgment and an warning order in an warning and an ACC following order and an accelerating deceleration orders 
5 ets. in the ACC based on the radar signal processing, preceding vehicle trapping, host vehicle lane judgment, etc. 
[0044] As for these various signals, they are communicated through a communications network 38 and a data com- 
munication part 46. 

[0045] The driver display unit 37 generate the alarm, do lighting and display the distance with the preceding vehicle 
according to a communication signal received. 
w [0046] According to setting modification of the driver to reverse, an adjustment of the distance that the warning 
occurs in the warning is performed, and the adjustment signal of the distance between the host vehicle and the preced- 
ing vehicle in the ACC is transmitted to the unit 35. In the digital signal attention circuitry 35, modification of the various 
parameter is enforced based on said adjusting signal. 

[0047] The vehicle side control part 36 is used in order to constitute the ACC system. 
is [0048] This is constituted with an engine control unit 51 , an AT control unit 52 and a braking control unit 53, the 
engine output, the AT shift position, and the automatic braking in order to slow down suddenly are performed in order 
to accelerate and to decelerate the vehicle by receiving a signal from the one body type millimeter wave radar system 
36. 

[0049] The vehicle side control part 36 is inputted various sensor signals which are necessary for controlling in the 
20 vehicle side, for example, a gyro sensor signal 6, a steering sensor signal 7, a vehicle speed sensor signal 26, a braking 
signal 260, a wheel velocity sensor signal 54, a shift position sensor signal 55, an acceleration sensor signal 56 etc. 
[0050] And, the signals which are necessary for the one body type millimeter wave radar system 35 side, for exam- 
ple, the vehicle velocity sensor signal 26 and the steering sensor signal 7 are transmitted through a communications 
network 38. 

25 [0051] In these system configuration, as the vehicle side control part 36 is a conventional technique and it is not 
described moreover in detail. 

[0052] In next, in said built-in software 47, a method to judge vehicle lane in a curved road and a derivation of oper- 
ating equation will be explained. 

[0053] Figure 4 shows a relationship between a own car which is on a circle contour of a curvature radius R s and a 
30 lead car which is on R f . 

[0054] Judging from the host vehicle, whether the preceding vehicle is on the host vehicle or on an adjacent vehicle 
lane, can be judged by a difference AR of the curvature radius between the host vehicle and the preceding vehicle orig- 
inally. 

[0055] Method of operation will be explained as follows. 



1 . A distance T r and a direction angle a are measured by using the millimeter wave radar, and a host vehicle angu- 
lar velocity and a host vehicle velocity V s is measured with the built-in gyro sensor 6. 

2. A side displacement T c , a longitudinal displacement T D and a host vehicle curvature radius R s are calculated 
with the next equations. 



35 



T C =T R sina » T D =T R C0Sa > R s= V s /o) s 



3. As shown in figure 4, as for the rotation radius R f of the preceding vehicle, the next equation is obtained. 



45 



R f 2 =R x 2 + T D 2 =(R s -T c ) 2 + T D 2 



4. Therefore, the next equation is obtained. 



[Equation 2] 



50 



[0056] 




(Equation 2) 



55 [0057] Here Ly is defined as a vehicle lane width. 
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[Equation 3] 
[0058] 

5 IARI<Ly/2 (Ly: one vehicle lane) (Equation 3) 

[0059] The vehicle lane of the host vehicle is judged when the above equation is satisfied. 

[0060] The value of Ly is not be a half vehicle lane width which is symmetric for an host vehicle because the host 
vehicle may not go on a center of the vehicle lane. 
w [0061] The setting method of the value Is disclosed in an embodiment explained later. 

[0062] Using figure 5 and figures 6A, 6B In the next, a correction method of the curvature radius R f of the preceding 
vehicle will be explained. 

[0063] Currently, the position of the preceding vehicle in a curved road is estimated by correcting on the basis of 
th angular velocity measured with the gyro sensor. 
is [0064] In this correction method to use the angular velocity of the host vehicle, the preceding vehicle is calculated 
to b on a circle extended from a rotation center of the position which is same as the current host vehicle. 
[0065] However, a real road does not consist of only a linear lane and a curve lane, and "a transition curve" section 
which is joined therebetween by changing R by degrees exists by all means. 

[0066] Accordingly, even rf it is assumed that the angular velocity is measured good enough in accurate, a right 
20 measurement is only performed when both of the preceding vehicle and the host vehicle is in a circle contour or a linear 
line. 

[0067] Accordingly, it becomes important that this transition curve is detected and the R is corrected in suitable. 
[0068] Figure 5 shows a transition section 62 connected to a linear line section 61 , a constant R section 63, a tran- 
sition section 64, and a linear line section 65 connected to said transition section 64. 
25 [0069] In other words, the R becomes small (the angular velocity increases) in the transition section 62 by degrees, 
the R becomes constant (angular velocity constant) in the constant R section 63 (circle contour section), the R 
increases by degrees (angular velocity decrease) when coming in a reverse transition section 64, and it is returned to 
a linear line section (In the linear line, R = °o). 

[0070] Accordingly even if it is assumed that the preceding vehicle and the host vehicle ran at the same vehicle lane 
30 center, when the host vehicle is on the transition section 62, the preceding vehicle travels on the small R than this sec- 
tion 62, and reversely, when the host vehicle is on the transition section 62, the preceding vehicle travels on a bigger R 
than a detected R of the host vehicle. 

[0071] Figures 6A, 6B shows a change of the angular velocity <o R , a change of the curvature radius R, and a cor- 
rection direction of the R detected when driving the curve. 
35 [0072] Shown in the figure, the R is corrected in the transition section 62 a little to be (R - AR) , the R is constant in 
the constant R section 63, the R is corrected greatly in the transition section 63 as (R+ AR) so as to estimate the lane 
of the preceding vehicle. 

[0073] Here, It is assumed that the preceding vehicle Is followed by a status without relative velocity with the host 
vehicle. 

40 [0074] Then the R is corrected using sensor information such as 

1 . A distance d with the preceding vehicle, and a direction angle 6 and The change AO, 

2. an angular velocity a> R every moment, and a change Aco R thereof, 

3. a steering angle <fr and a change velocity 5 <j> thereof. 

45 

[0075] Figure 7 is a flow, chart showing a correction step. 

[0076] At first, in a step 701 , a distance d(t) with the preceding vehicle at a time t, the preceding vehicle direction 
angi 8(t), the angular the velocity co R (t), and the steering angle 4>(t) is detected and is stored. 

[0077] In a step 702 in the next, a change A6(t), Ata^t) and &|>(t) of G(t), <o R (t), <t>(t),are obtained by performing a d'rf- 
50 ferentiation filter processing using past time M , t-2, ••• . 

[0078] In a step 703, absolute values I A6(t) I and I 8<|>(t) I of the A0(t) and &|>(t) are judged. 

[0079] When the absolute values are changed greatly together, it is taken as a vehicle lane change and it is taken 

off from an object to be corrected (step 704). 

[0080] On the other hand when it is not judged so, it is taken as the object to be corrected. 
55 [0081] In a step 705, plus and minus of Ato R (t) are judged. In case of A© R >0, the host vehicle is judged to be in the 
transition section 62, and the R is corrected to be small as (R-AR) (step 706,). 

[0082] In a case of Ao> R <0, the host vehicle is judged to be in the reverse transition section 64, and the R is cor- 
rected to be large as (R+AR) (step 707). 
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[0083] In a case of Aco R =0 , the host vehicle is judged to be in the circle contour section "61 , and the R is not cor- 
rected (step 708). 

[0084] By the way, in a case that an warning and a ACC system are constituted with a millimeter wave radar as a 
key sensor, there are comparatively a few problems about a moving object such as the preceding vehicles driving. 
5 [0085] However, in a case to perform the warning for forward stationary object or the ACC deceleration control, the 
millimeter wave radar can measure the distance with a target, a relative velocity and angle in accurate, but it is difficult 
to recognize what it is. 

[0086] For example, when there is a curve in a forward direction, even if it is assumed that a stationary object is 
caught on a forward driving direction, it is difficult to judge whether it is a stopping vehicle on an host vehicle lane or a 
10 road sign installed on the road side and over the road. 

[0087] In this way, the case that cannot be Judged only with the millimeter wave radar exists sometimes. 

[0088] So in figure 8, in order to judge the warning for the stationary object precisely, an embodiment is provided 

which has a CCD camera being another kind of a sensor in an embodiment of figure 1 . 

[0089] The same numerals are referred to the constitution to be same as the constitution of an embodiment shown 
is ah ad in order not to repeat the same description. 

[0090] The figure shows a distance between the vehicles alarm system 70 constituted by using signals from the mii- 
lim ter wave radar, the gyro sensor, the steering sensor and the CCD camera. 

[0091] In the figure, the CCD camera 71 is used for white line recognition 72 usually by a photography pictorial 
image thereby, and has a zoom lens function. 
20 [0092] On the other hand, the millimeter wave radar performs a stationary object sensing.f rom a distance, a relative 
velocity and an angle. 

[0093] When the millimeter wave detects the stationary object 23 forward now, the camera stops a white line rec- 
ognition 72 temporarily and zoom up the forward stationary object which the millimeter wave caught. 
[0094] The stationary object recognition 73 is performed, and whether it is an obstacle such as the stopping vehicle 
25 or not, and whether it is non-obstacles such as a road sign outside of the road and an overhead bridge or not are 
judged. 

[0095] Based on this stationary object recognition, the warning judgment 1 4 is performed, an warning designation 
1 5 for a stationary object is performed and an alarm signal 1 6 is given to a driver display unit 1 7. 
[0096] Figure 9 shows an ACC System 75 similarly using signals from the millimeter wave radar, the gyro sensor, 
so the steering sensor and the CCD camera. 

[0097] In the same way as the figure 8, a stationary object sensing - recognition is performed, and an accelerating 
and decelerating judgment 25 of the vehicle is performed based on a signal from the stationary object recognition 73 
(A reducing speed judgment for the stationary object). 

[0098] Figure 1 0 shows a case to distinguish the overhead bridge and the stopping vehicle as one example of the 
35 stationary object. 

[0099] The millimeter wave radar detects the overhead bridge in a considerably forward position, 100-150 [m] 
ahead numerically, 

[0100] In this period, it cannot be distinguished whether the forward stationary object is the overhead bridge or the 
stopping vehicle. 

40 [0101] When the detected stationary object is the stopping vehicle, it becomes necessary to warn in this period 
because it takes much time for the deceleration in a high-speed driving with more than 1 00km per an hour. 
[0102] Then, whether it is the overhead bridge or the road obstacle such as the stopping vehicle, is judged by per- 
forming the image processing using the camera. The image processing means to distinguish the target by a pattern 
matching and a sensing accuracy is not demanded so much. 

45 [0103] As a result of discrimination, when it is taken as the overhead bridge, the alarm is not outputted. 

[0104] In this way, it becomes possible to improve the accuracy of the warning by combining the target sensing by 
the millimeter wave with the target discrimination by the camera image processing. 

[0105] By the way, if it is assumed that the forward stationary object is discriminated and it is the obstacle such as 
the stopping vehicle on the vehicle lane, they are not complete as a judgment object for outputting the warning. 
so [0106] For example, in a cases that there is a branching road forward, and there is a stopping vehicle on one side 
thereof, an accurate judgment whether the warning should be outputted is not performed if it is not understand which 
course the vehicle selects. 

[0107] Then, in figure 11 , a distance between the vehicles alarm system 76 constituted by using a signal from a 
navigation system in addition to the millimeter wave radar, the gyro sensor, the steering sensor, and the CCD camera. 
55 In the figure, a path judgment 78 is performed by using the navigation system 77. 

[0108] With the sensor except the navigation system, the stationary object sensing and the stationary object rec- 
ognition are performed, and it is assumed that the warning object such as the stopping vehicle is judged. 
[0109] Then, according to a path judgment function 78 by the navigation system 77, it is judged whether the warn- 
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ing object is on the driving vehicle lane in the future, and warning designation 15 is performed only when it is judged to 
be on the driving vehicle lane. 

[0110] Accuracy of the warning designation 15 improves hereby. 

[011 1] In figure 12, an ACC system 75 constituted by using asignal from the millimeter wave radar, the gyro sensor, 
5 the steering sensor, the CCD camera and the navigation system. In the figure, an accelerating and decelerating judg- 
ment 25 is performed based on the signal by a path judgment 78. 

[0112] Thereby the distance between the vehicles control is performed in highly accurate. 
[0113] In the embodiment shown in figure 8 to figure 1 1 that mentioned the above, it was realized to alarm for a sta- 
tionary object and to control it in highly accurate by adding the camera and the navigation system in addition to the mii- 
10 limeter wave radar. 

[0114] In the following embodiment, the system which used only the gyro sensor and the steering sensor is pro- 
vid d as the millimeter wave radar and an auxiliary sensor shown in figure 1 and figure 2. 

[011 5] In this case, even if it is assumed that the circumstances is limited, it may be realized to alarm and control it 
in highly accurate by solving the following problems. 

15 

1 . Cannot a curve to start with the forward host vehicle be estimated ? 

2. Cannot estimate where of center or side of the host vehicle lane the host vehicle runs ? 

3. Cannot judge whether there is a stationary obstacle on the host vehicle lane from a relationship of transfer 
objects ? 

20 

[0116] They will be explained based on drawings as follows. 

[0117] Figures 13 (a), 13 (b) shows two cases that a driving vehicle moves in forward of the host vehicle into lateral 
direction on the road having plural driving vehicle lanes. 

[0118] Figure 13A shows a case that the host vehicle is before the curved road and the forward preceding vehicle 
25 is on the curved road, and figure 13B shows a case that the preceding vehicle changes the vehicle lane. 

[0119] In figure 1 3A, the preceding vehicle is a object to be alarmed or be followed continuously, and in figure 13B, 
the preceding vehicle becomes not to be the following object 

[0120] When both is looked at from the host vehicle, the preceding vehicle looks to move to the lateral direction, it 
can be distinguished from the movement of other vehicle. 
30 [0121] In other words, forward vehicle 1 and forward vehicle 2, and the preceding vehicle moved to the same lateral 
direction are detected, and it is judged to be the curved road when they moved to the same lateral direction, and it is 
judged to be the vehicle lane change when they moved to the different direction. 
[0122] Figure 14 is a flow chart showing steps to distinguish figure 13A and figure 13B. 

[0123] At first in step 1 401 , the velocity of the preceding vehicle (d1 (t), 61 (t), Vf 1 (t)) is detected from a distance with 
. 35 the preceding vehicle 1 at time t, the direction angle, and from the host vehicle velocity and the relative velocity. 

[0124] Similarly, relating to the forward vehicle 2, 3 except the host vehicle lane, (d2(t), 62(t), Vf2(t)), (d3 (t), 63(t), 
Vf3(t)) are detected. (The forward vehicles to be detected is determined to be two here, however when it can be 
detected more, detected vehicle number may be increased). 

[0125] In a step 1402 in the next, using data of past times M,t-2, •• a differentiation filter process is performed, 
40 and the changes A61 (t), A62(t), A63(t) of 61 (t), 6 2(t), 63(t) are obtained. 

[0126] In a step 1403, (A61 (t)/Vf1 (t)), (A62(t)A/ f2(t)), (A63(t)/Vf3(t)) are obtained. 

[0127] These are equivalent to an angle which changes corresponding to the driving distance of the vehicle, and it 
does not depend on the velocity of each vehicle. Using this in a step 1404, a transfer distance of the preceding vehicle 
and forward vehicles 1 , 2 is obtained so as to be judged by obtaining AM12 and AM13 based on equations as follows. 

45 

AM12= I(A61/Vf1) - (A62/Vf2) I, and 

AM13 = 1(561 A/f1) - (A63/Vf3) I 

so [0128] The values of A IVI12 and A M13 are equal to or less than a predetermined value, it is judged to be the trans- 
fer on a curve (step 1405). 

[0129] On the other hand when it is bigger than the value, it is judged to be the vehicle lane change (step 1406). 
[0130] An example is shown here, in which, the host vehicle and the preceding vehicle runs at the center of a 3 vehi- 
cle lanes, and other ones respectively run on right and left vehicle lanes. 
55 [0131] If the forward vehicle except the preceding vehicle Is caught on or more than two vehicle lanes, a similar esti- 
mation may be performed. 

[0132] However, estimation accuracy improves further when the more vehicles are captured. 

[0133] Although the hypothesis is different from a cases that the forward vehicle especially changes the vehicle 
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lane, such a false estimation can be avoid by increasing captured vehicle. 

[0134] By the way in figures 13 (a) or (b) figure, in the host vehicle lane estimation, the vehicle lane position of the 
preceding vehicle is judged by supposing that the host vehicle run the vehicle lane center. 

[0135] For example, as shown it in figure 13A, the preceding vehicle and forward vehicle run at the vehicle lane 
center, and the lateral position of each vehicle is almost equal to the vehicle lane width Ly, there is not a problem. 
[0136] However, as in figure 13B, when the host vehicle, the preceding vehicle, and the forward vehicle deviate to 
one end of the vehicle lane, it becomes difficult to understand which is the preceding vehicle. 

[0137] Including this case, the driving position to the white line of the host vehicle is estimated, and it is important 
to reflect it to the preceding vehicle judgment by offsetting the range of the host vehicle lane to the right or the left. 
[0138] Figure 1 5 shows a flow chart relating to a method to estimate the host vehicle position and to offset the host 
vehicle lane position to the right or the left based on the estimated host vehicle position. 

[0139] At first in a step 1 601 , the lateral position YL(t), YR(t) of the right and the left forward vehicle, are obtained 
xcept one vehicle which is recognized as the preceding vehicle. (When it cannot be judged as shown in the figure 1 3B, 
on in a side which the direction angle is small, is judged to be the preceding vehicle.) 

[0140] In a step 1 602, a moving average values <YL(t)>, (YR(t)) of YL(t), YR(t) which are sampled a predetermined 
times in the past. 

[0141] In step 1603, corresponding to <YL(t)), <YR(t)) obtained, Ly+ALy<{«YL(t)>+<YR(t)»/2>}<Ly- A Ly is judged. 
(Here Ly : one vehicle lane width, A Ly : value to be smaller than the one vehicle lane width). When the condition is not 
satisfied, it is assumed that reliability of the data is low, and it is not adopted. 

[0142] When the condition is satisfied, the step 1604 is absorbed and is judged according to the next equation. 
[0143] When {<YL(t))-Ly}>ALy and {<YR(t)>-Ly)<A Ly , it is judged as a right side moving. 
[0144] When {<YL(t))-Ly}<ALy and {<YR(t)>-Ly}>A Ly , it is judged as a left side moving. 
[0145] When {(YL(t))-Ly}<ALy and {<YR(t)>-Ly}<A Ly , it is judged as a center. 

[0146] In a step 1 605, the range of the host vehicle lane judgment is offset to the right side or to the left side, or it 
is judged to be maintained according to the result. 

[0147] The above is a case in which the vehicles run at the center of the three vehicle lanes, and even if it is two 
vehicle lane or a forward road it is possible to be similar. 

[0148] In this case, the forward vehicle in only one side or transverse direction distance with the forward vehicle are 
used for a reference, and reliability is improved by increasing number of the sample. 

[0149] Further, in this method, because of a problem relating to an installation of the millimeter wave radar, even if 
when it must be mounted on the right or the left of the vehicle, it can be revised by estimating automatically. 
[0150] A case that the preceding vehicle moves to the transverse direction and the stationary object appeared over 
there, will be explained in the next. 

[0151] Figures 16A and 1 6B show a case that the preceding vehicle moves to the transverse direction and the sta- 
tionary object appeared over there. 

[0152] Basically, an alarm is generated in figure 1 6A, and it is not generated in figure 16B. 

[0153] However, because a course forward cannot be predicted, they can not be distinguished. 

[0154] Then, figure 17 shows a method to plan to distinct the both by paying attention to the transverse moving 

velocity of the preceding vehicle and the pattern. 

[0155] When, the transverse moving velocity of the preceding vehicle is shown with a relationship with time as 
shown in the figure, the curved road is detected showing a gentle change, however, in case of vehicle lane change, the 
velocity is large at first because the steering angle is large, and the lateral direction velocity disappears because the 
ste ring is returned after the vehicle lane change, so that it is detected as a variation of a convex shape. 
[0156] The host vehicle closes to the stationary object while detecting the movement of the preceding vehicle, and 
a timing to alarm judgment at time T1 , T2, and T3 according to the vehicle velocity of the host vehicle and the distance 
between the cars, becomes different. 

[0157] In cases of T2, T3, the judgment is easy, and the both can be distinguished easily by detecting a changing 
pole point P of the preceding vehicle driving speed. 

[0158] On the other, in time T1 , the both is needed to be distinguished on the basis of one threshold value. 
[0159] This threshold value is changed at any time according to the host vehicle velocity, the preceding vehicle 
velocity, the preceding vehicle direction angle, the host vehicle angular velocity and the distance between the vehicles. 
[0160] Figure 18 shows a case that an oncoming vehicle goes across the stationary object which is more distant 
than the oncoming vehicle. 

[0161] in such a case, it is hot considered to be the stationary object which is on the host vehicle lane and the alarm 
is not generated. 

[0162] In such a method, the oncoming car is captured in a direction angle neighborhood of the stationary object 
caught at first, if the distance between the vehicles is closer than the stationary object, the stationary object is consid- 
ered to be outside of the vehicle lane and it is not an object to be generated the alarm. 
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0163] In this case, this judgment is performed on the basis of a time difference that caught the stationary object 
and the oncoming vehicle and by correcting the movement of the host vehicle. 
0164] As stated above, in the present invention, 

A correct estimation equation of the preceding vehicle position is provided, and a device which used it is proposed. 
The correction amount is changed at an introduction part of the curve: angular velocity generation early stage (an 
increase direction), and at a rear part of the curve: angular velocity generate later stage (a decrease direction). 
On the basis of the sensing positions of plurality of the preceding vehicles, white line position is estimated. 

0165] The curve forward and the branching are Judged by detecting the movement amount in the lateral direction 
of the forward vehicle. 

Judgment of the host vehicle lane and the position correction of the preceding vehicle are performed by using both 
of the gyro sensor and the steering sensor. 

The lane position judgment of the preceding stationary object and presence judgment of the stationary object warn- 
ing are performed by movement of the preceding vehicle. 

The lane position of the preceding stationary object is judged by a relation with the oncoming vehicle. 
Th stationary object which is detected forward is recognized to be a stationary target on the road and the warning 
is not generated when it is the stationary target. 

When the stopping vehicle is captured on the driving lane, the driving lane is judged whether it is a driving route of 
the host vehicle or not, and if it is judged to be the driving route of the host vehicle, a warning is generated. 
A one body type millimeter wave radar system building in a communications network facility and a judgment • con- 
trol function. 

Effect of the invention] 

0166] As being constructed as above, the present invention has effects as follows. 

Distance of the host vehicle with the preceding vehicle is controlled to become a desired value, by detecting a pre- 
ceding vehicle on a host vehicle lane(including a stopping vehicle) using a millimeter wave radar, or when the host 
vehicle comes too much close with the preceding vehicle, a collision warning is generated. 
In addition, a warning or the control (deceleration) can be performed only the forward stopping vehicle of the host 
vehicle lane, by distinguishing the stopping preceding vehicle from the road sign on the road side and the stationary 
object such as the overhead bridge. 

On the basis of movement of the preceding vehicle which the radar caught and other sensor information, an accu- 
rate host vehicle lane estimation and a position correction of the vehicle can be performed in a curve road. 
The lane position estimation of the preceding vehicle is performed by receiving various data from the vehicle side 
and by combining It with the sensing information obtained by the millimeter wave radar, a warning and a control 
command information can be transmitted to the vehicle side. 

Claims 

1 . A vehicle control method comprising the steps of 

45 detecting a velocity and angular velocity of a host vehicle, and a distance and a direction from said host vehicle 

to a preceding vehicle or a target, 

calculating a next distance from said host vehicle to said preceding vehicle or said target based on said veloc- 
ity, angular velocity and said direction detected in the former step, and 

controlling said host vehicle so as to decelerate said host vehicle when said next distance is smaller than a pre- 
so determined value. 

2. A vehicle control method as defined in claim 1 , said vehicle control method characterized in that 

said predetermined value is samller than a half of a vehicle lane. 

3. A vehicle warning method comprising the steps of 
detecting a velocity and angular velocity of a host vehicle, and a distance and a direction from said host vehicle 
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to a preceding vehicle or a target, 

calculating a next distance from said host vehicle to said preceding vehicle or said target based on said veloc- 
ity, angular velocity and said direction detected in the former step, and 
generating a warning when said next distance is smaller than a predetermined value. 

5 

4. A vehicle control method as defined in claim 1 , said vehicle control method characterized in that 

said predetermined value is smaller than a half of a vehicle lane. 

70 5. A vehicle lane position estimation device for capturing a preceding vehicle (3) or a target by searching forward of 
an host vehicle (2) and estimating vehicle lane position thereof, said vehicle lane position estimation device com- 
prising 

a means for measuring a distance T R between said host vehicle and said preceding vehicle or said target, a 
is direction angle a from said host vehicle, an angular velocity Ws and a velocity VS of said host vehicle, 

one vehicle lane sensing means for obtaining a lane Ly of a road, 

a means for calculating a lateral displacement T c between said host vehicle (2) and said preceding vehicle (3) 
or said target, a longitudinal displacement T D therebetween and a curvature radius R of said host vehicle (2) 
based on a following equation 



20 



50 



T c = T r sina, T D = T R cosa, R - Vs/Ws, 



a means for calculating lateral distance AR between said host vehicle (2) and said preceding vehicle (3) or said 
target based on a following equation, 
25 [Equation 1] 

Afl = J{R -T C ) 2 +T D 2 -R (Equation 1) 

a means for comparing Ly/2 with AR, and 
30 a means for judging said preceding vehicle or said target to be in a vehicle lane of said host vehicle when 

IARI < Ly/2. 

6. A vehicle lane position estimation device as defined in claim 5, further comprising 

35 a means forjudging whether a curve of said road is a transition curve section where a curvature radius thereof 

changes every moment sometimes, or a maximum curve section where said curvature radius does not 
changes, and 

a means for correcting a curvature radius R s of said host vehicle used for correcting said curvature radius Rf 
of said preceding vehicle to be smaller than a predetermined value when a transition curve is in an introduction 
40 part of the curve, and for correcting said curvature radius Rs to be larger than said predetermined value when 

said transition curve is in an rear part of the curve. 

7. A vehicle lane position estimation device as defined in claim 5, further comprising 

45 a means for obtaining a judgment position of a vehicle lane of said host vehicle by estimating a vehicle lane 

position of plural said preceding vehicle and making a vehicle lane judgement position of said preceding vehi- 
cle offset towards right or left according to said vehicle lane position estimated. 



8. A vehicle lane position estimation device as defined in claim 5, wherein 

a millimeter wave radar arid a gyro sensor (6) are used as said means for measuring. 

9. A vehicle (ane position estimation device as defined in claim 5, wherein 

55 a steering sensor (7) and a gyro sensor (6) are used as said means for measuring. 

10. A vehicle lane position estimation device as defined in claim 5, wherein 
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a CCD camera (71) arid a navigation device (77) having a route guidance function are used as said means for 
measuring. 

11. A vehicle lane position estimation device as defined in claims 5 to 10, further comprising 

a means for obtaining a distance of the host vehicle from said preceding vehicle (3), and 
a means for warring when said distance becomes a predetermined distance. 

12. A vehicle lane position estimation device for estimating a position of a vehicle lane of a stationary object (a forward 
stationary object) to be located before an host vehicle (2), comprising 

a means for measuring a distance between said host vehicle (2) and said preceding vehicle (3) or an oncoming 
vehicle, a direction angle from said host vehicle (2), an angular velocity and a velocity of said host vehicle (2), 
one vehicle lane sensing means for obtaining a vehicle lane of a road, 

a means for calculating a lateral displacement between said host vehicle (2) and said preceding vehicle (3) or 
said oncoming vehicle, a longitudinal displacement therebetween and a curvature radius of said host vehicle, 
a means for capturing a forward stationary object, 

a means for obtaining a movement of said preceding vehicle or a position of said oncoming vehicle, 
a means for estimating a vehicle lane position of said forward stationary object from a movement relationship 
of said preceding vehicle obtained and said forward stationary object captured or a position relationship with 
said oncoming vehicle, and 

a means for warring when said forward stationary object is in a vehicle lane of said host vehicle (2). 

13. A vehicle lane position estimation device as defined in claim 12, further comprising 

a means for calculating lateral distance AR between said host vehicle and said forward stationary object based 
on following equations 



wherein 

T is a distance between said host vehicle and said forward stationary object, a angle from said host vehicle, 
Ws velocity of said host vehicle, Vs velocity of said host vehicle, T c lateral displacement, T D longitudinal dis- 
placement, and R curvature radius of said host vehicle. 

14. A vehicle lane position estimation device as defined in claim 12 or 13, further comprising 

a means for recognizing whether said forward stationary object is an object on the road such as an overhead 
bridge. 



T c =T R sina, T D =T R cosa, R=Vs/Ws and 



[Equation 1] 




( Equation 1) 
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FIG. 4 
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(54) Vehicle control method and vehicle warning method 



(57) In order to occur a collision warning to prevent 
the collision in accurate by detecting the preceding vehi- 
cle (3) or target, a vehicle lane position estimation 
device comprising a means for measuring a distance 
between said host vehicle (2) and said preceding vehi- 
cle (3) or a oncoming vehicle, a direction angle from 
said host vehicle (2), an angular velocity and a velocity 
of said host vehicle (2), a means for calculating lateral 
and longitudinal distance between said host vehicle (2) 



and said preceding vehicle (3) or said oncoming vehicle, 
a means for capturing a front stationary object, a means 
for obtaining movement of the preceding vehicle (3) or 
position of the oncoming vehicle, and a means to esti- 
mate a lane position of said front stationary object from 
a relationship of the stationary object being captured 
and the preceding vehicle (3) being obtained and a 
positional relationship with the oncoming vehicle. 
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